package edu.wpi.first.wpilibj.templates.subsystems;

/**
 * 
 * @author FRC Team 3255
 */

import edu.wpi.first.wpilibj.command.Subsystem;
import edu.wpi.first.wpilibj.Servo;
import edu.wpi.first.wpilibj.DoubleSolenoid;
import edu.wpi.first.wpilibj.Relay;
import edu.wpi.first.wpilibj.Solenoid;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import edu.wpi.first.wpilibj.templates.RobotMap;
import edu.wpi.first.wpilibj.templates.commands.*;

public class Camera extends Subsystem {
    // Put methods for controlling this subsystem
    // here. Call these from Commands.
    
    private Servo servo;
    
    private static final double UP_ANGLE = 15;
    private static final double DOWN_ANGLE = 70;
    
    public boolean isUp;
    
    public Camera(){
        servo = new Servo(RobotMap.CAMERA_SERVO);
    }
    
    public void lookUp() {
        servo.setAngle(UP_ANGLE);
        isUp = true;
    }
    
    public void lookDown() {
        servo.setAngle(DOWN_ANGLE);
        isUp = false;
    }
    
    public boolean isLookUp() {
        return isUp;
    }
    
    public void initDefaultCommand() {
    }
}